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Abstract 


Terrestrial  manipulators  with  more  dof  than  the  dimension  of  the  workspace 
and  space  manipulators  with  as  many  manipulator  dof  as  the  dimension  of 
the  workspace  are  both  redundant  systems.  An  interesting  problem  of  such 
redundant  systems  has  been  the  repeatability  problem  due  to  the  presence  of 
nonholonomic  constraints.  We  show  in  this  paper,  contrary  to  the  existing 
belief,  that  integrability  of  the  nonholonomic  constraints  is  not  a  necessary 
condition  for  the  repeatability  of  the  configuration  variables.  There  exist 
certain  trsgectories  in  the  independent  configuration  variable  space  that  are 
like  'holonomic  loops”  along  which  the  redimdant  manipulators  exhibit 
repeatable  motion.  In  this  paper  we  present  a  simple  method  based  on 
optimization  techniques  for  designing  repeatable  trajectories  for  free-flying 
space  manipulators  and  terrestrial  redundant  manipulators  under 
pseudoinverse  control. 


*A  part  of  this  p^)er  was  accepted  for  publication  in  the  1994  IEEE  International  Conference 
on  Robotics  and  Automation. 


1.  Introduction 


An  important  problem  of  kinematically  redundant  robot  manipulators  has  been  the 
repeatability  problem  under  pseuduinverse  control.  This  problem  was  initially  observed  and 
analyzed  by  Klein  and  Huang  |7j  where  rea>lved  motion  rate  control  |22j  using  the  Jacobian 
pseudoinverse  was  noticed  to  result  in  nonrepeatable  joint  motion.  As  an  alternative  to  the 
pseudoinverse  control,  BaillieuI  (2]  propt^ed  the  extended  Jacobian  technique  that  lifted 
closed  end-elTector  paths  to  closed  joint  paths.  Later,  Seraji  [15]  proposed  the  configuration 
control  technique  that  also  resulted  in  repeatable  joint  motion.  The  key  idea  behind  the 
extended  Jacobian  teclmique  was  to  add  enough  independent  additional  constraints  to  the 
motion  of  the  manipulator  so  that  the  rectangular  Jacobian  of  the  redundant  manipuiaun 
could  be  converted  into  a  square  Jacobian  of  full  rank.  When  the  additional  constraints 
that  are  imposed  upon  the  motion  of  the  redundant  manipulator  are  holonomic  in  nature, 
the  full  rank  square  Jacobian  guarantees  repeatability  in  the  joint  motion. 

Though  the  pseudoinverse  control  does  not  produce  repeatable  joint  motion  in  general, 
it  is  fundamentally  similar'  to  the  extended  Jacobian  teclurique  in  the  sense  that  it  is  also  a 
form  of  constrained  motion.  For  a  redundant  manipulator  with  n  degrees  of  freedom  anil 
a  workspace  of  dimension  m,  the  dimension  of  the  null  space  of  the  manipulator  Jacol>ian 
is  eriual  to  (n  -  m).  'I'lie  extended  Jacobian  techniiiue  |2j  imposes  («  -  m)  additional 
independent  constraints  on  the  motion  of  the  system  to  make  the  Jacobian  s(|uare  and  full 
rank.  The  pseudoinverse  ixuitrol  is  equivalent  to  the  im))osition  of  (u-m)  constraints  that 
direct  the  motion  of  the  joints  orthogonal  to  the  (n-m)  dimensional  null  space.  While  the 
constraints  due  to  pseudoinverse  control  ar  e  nonholonomic  or  nonintegrable,  the  constraints 
imposed  by  the  extended  Jacobian  teclmique  are  holonomic  or  integrable.  'riierein  lies  the 
essential  difference  between  the  two  approaclres,  more  of  which  will  be  discussed  in  section 
2. 

The  pseudoinverse  control  |iroblem  has  been  siudieil  by  a  number  of  resi:archcis  |7], 
[8],  [9],  and  [16j.  Klein  and  Huang  (7|  analyzed  the  nonrepeatability  problem  of  a  three 
link  planar  redundant  manipulator  in  terms  of  the  integrability  condition  of  a  Ffailian 
differential  form.  Shamir  and  Yomdin  (IGj  asserted  that  for  a  redundant  manipulator 
repeatability  is  guaranteed  if  and  only  if  there  exists  an  integral  surface  of  the  distiibutiun 
spanned  by  the  column  vectors  of  the  Jacobian  pseudoinverse.  Under  the  differential 
geometric  framework  adopted,  it  was  concluded  that  the  repeatability  of  a  reflundant 
manipulator  can  be  assured  if  and  only  if  a  certain  “Lie  Bracket  Condition”  (LUC)  is 
satisfied.  In  section  3  of  this  paper  we  will  show  that  this  LBC  is  not  a  necessary  condition 
for  the  repeatability  of  redutrdant  manipulators.  We  will  also  show  in  section  2  that 
the  LBC  is  not  a  suiffeient  condition  for  repeatability  when  applied  to  arbitrar  y  extended 
Jacobiarrs.  This  currtradicts  some  of  the  diserrssion  by  Liro  and  Ahmad  [9]  who  discussed  the 
measure  of  repeatability  for  plaitar  redundarrt  manipirlators  under  irseudoinvcrse  control. 
They  used  a  framework  based  on  the  theory  of  integr  ation  on  manifolds.  The  authors  in 
|7],  (9),  and  (16)  have  all  corrcluded  in  essence  that  integrability  is  a  rrecessary  condition 


1 


for  the  repeatability  in  redundant  manipulators.  Similar  opinion  was  also  expressed  in  |3). 
We  do  not  quite  agree  with  this  statement.  Our  contention  is  that  integrability  is  only  a 
sufficient  condition  for  repeatability,  it  is  by  no  means  a  necessary  condition.  In  section  3 
will  derive  a  weaker  necessaiy  condition  for  the  repeatability  in  redundant  manipulators. 

In  1989  Klein  and  Kee  j8)  presented  a  numerical  promlure  to  find  stable  tlrift-free 
trajectories  in  redundant  manipulators  under  pseudoinverse  control.  Later,  Klein  (6j  tried 
to  predict  the  stable  drift-free  trajectories  of  (8]  by  using  the  Lie  Bracket  Condition  (LBC) 
in  (16).  The  results  indicated  that  the  stable  trajectories  in  (8J  are  not  contained  in  the  LBC 
surfaces  of  (16).  This  bears  testimony  to  the  fact  that  the  LBC  of  (16)  is  not  a  necessary 
condition  for  repeatability. 

Recently  Roberts  and  Maciejewski  (14)  presented  a  necessary  and  sufficient  condition 
for  the  existence  of  stable  surfaces  for  repeatable  motion  in  redundant  manipulators.  They 
showed  that  the  Lie  Bracket  Condition  (LBC)  of  (16)  is  a  necessary  condition  for  the 
existence  of  an  integial  surface,  but  it  is  not  a  sufficient  condition  for  the  surface  to  be 
stable  for  repeatability.  Since  stable  surfaces  are  quite  rare,  the  authors  (14)  designed  a 
repeatable  control  that  is  nearest,  in  an  integral  norm  sense,  to  a  desired  optimal  control. 
In  this  paper  we  aie  concerned  with  repeatable  trajectories  but  not  with  their  stability. 
Though  the  LBC  is  a  necessary  condition  for  a  stable  surface,  we  show  that  it  is  not  a 
necessary  condition  for  repeatability.  Using  a  necessai'y  condition,  weaker  than  the  LBC, 
we  will  show  the  existence  of  “holonoinic  loops”  that  lift  closed  paths  in  the  workspace  to 
closed  paths  in  the  joint  space  under  pseudoinverse  control. 

With  no  intention  of  digressing,  we  would  like  to  mention  that  space  robots  with  as 
many  manipulator  degrees  of  freedom  as  the  dimension  of  the  workspace  exhibit  a  special 
kind  of  redundancy  called  “nonholonomic  redundancy”.  It  was  shown  that  nonholonomic 
redundancy,  unlike  ordinary  redundancy,  manifests  itself  only  after  a  global  motion  and 
is  not  characterized  by  “self-motion”  manifolds  (12).  Inspite  of  fundamental  differences 
between  nonholonomic  redundancy  and  ordinary  kinematic  redundancy,  more  of  which 
will  be  discussed  in  section  2,  the  control  problem  in  both  is  characterized  by  the  noii- 
integrability  of  the  distribution  spanned  by  the  vector  fields  of  the  system.  Hence  the 
repeatability  problem  in  space  manipulators  with  no  additional  degrees  of  freedom  and 
terrestrial  redundant  manipulators  are  inherently  similar. 

Since  space  manipulators  are  also  redundant  systems,  the  repeatability  problem  in 
space  maniptilators  fall  within  the  scope  of  this  resoaich.  While  the  problem  of  reorienting  a 
space  multibody  system  using  internal  motion  has  been  studied  by  a  number  of  researchers 
(10),  (11),  (13),  (18),  (21),  (23),  etc.,  an  important  problem  that  has  not  been  addressed  so 
far  is  the  repeatability  problem  in  space  manipulators.  The  motion  of  the  end-effector  of  a 
space  manipulator  is  related  to  the  joint  motions  through  the  “generalized  Jacobian”  (19) 
by  eliminating  the  dependence  of  the  end-effector  motion  on  the  chcUige  of  orientation  of  the 
space  vehicle.  While  the  joints  of  the  space  robot  move  along  closed  paths,  the  orientation 
of  tlie  s)>ace  vehicle  does  not.  Consecjuently  the  end-elfector  of  the  space  in<uii|>ulatoi  diu^s 
not  move  along  a  closetl  path.  And  conversely,  the  joints  of  the  space  robot  fail  to  move 
along  a  closed  path  when  the  end-effector  traces  a  closed  path.  While  a  more  complete 


2 


discussion  on  this  topic  will  follow  in  section  2.3,  we  only  like  to  reiterate  here  that  the 
manifestation  of  redundancy  in  terms  of  nonrepeatability  in  the  configuration  variables  is 
observed  in  nonholonomically  redundant  space  robots  and  ordinarily  redundant  terrestrial 
robots  alike. 

The  rest  of  the  paper  is  organized  as  follows.  In  section  2  we  take  a  look  at  the  control 
of  redundant  manipulators,  including  space  manipulators,  from  a  different  perspective.  In 
section  3  we  derive  a  necessary  condition  for  repeatability  in  nonholonomic  systems  like 
space  manipulators  and  redundant  manipulators  under  pseudoinverse  control.  We  use  this 
necessary  condition  to  find  repeatable  trajectories  for  nonholonomically  redundant  space 
manipulators  in  section  4  and  ordinarily  redundant  terrestrial  manipulators  in  section  5. 
In  section  6  we  present  some  results  obtained  through  computer  simulation. 

2.  A  Different  Perspective  on  Redundant  Manipulator  Control 
2.1  Pseudoinverse  Control  as  a  form  of  Constrained  Motion 

Kinematically  redundant  manipulators  have  more  degrees  of  freedom  than  the  dimen¬ 
sion  of  the  workspace.  For  such  systems,  the  direct  kinematic  relationshi])  cun  be  wiitten 
in  the  form 


x  =  fiO)  (1) 

where  x  €  i?'"  represeiUs  the  workspace  variables,  0  €  If'  represents  the  manii>ulator’s 
joint  variables,  and  n  >  m  by  the  definition  of  redundancy.  Differentiating  Eq.(l),  we  get 

®  =  J0.  (2) 

where  J  is  the  manipulator  Jacobian  matrix.  The  pseudoinverse  solution  invokes  the 
control  law 


d=J*X  (3) 

where  J*  €  is  the  pseudoinverse  of  J.  We  will  always  assume  in  our  discussion 
that  the  manipulator  is  not  at  any  singular  configuration.  Therefore  the  Jacoliian  will 
always  have  full  rank  and  the  null  spac«  of  the  Jacobian  will  have  a  dimension  of  (n  -  m). 
The  pseudoinverse  solution  has  the  minimum  norm  properly  which  im]>lies  that  tlie  joint 
motion  0  obtained  from  Eq.(3)  will  have  to  be  orthogonal  to  the  null  space  of  J.  'I'hc 
orthogonality  re(]uirement  is  a  constraint  on  the  joint  velocities  0.  Since  the  null  spai:e 
of  J  has  a  dimension  of  (n  -  m),  the  pseudoinverse  solution  in  Eq.(3)  will  impose  (/t  -  m) 
velocity  constraints,  'lb  illustrate  this  concept  we  consider  the  simple  three  link  ]>laiiui' 
redundant  manipulator  shown  in  Fig.l.  The  lengths  of  all  the  links  of  the  manipulator  are 
assumed  to  be  unity  for  simplicity.  'I'he  workspiice  is  defined  by  the  Cartesian  coordinaU^ 
X  and  Y  and  the  manipulator  configuration  is  described  by  the  absolute  angles  Oi,  $-2,  and 
O3.  The  direct  kinematic  relationship,  as  in  Eti.(l),  is  of  the  form 
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X  =  CO&Oi  COsO-i  +  cos 03 
Y  =  sin  01  +  sill  0a  +  sin  03 
Therefore  the  Jacobian  matrix,  as  in  Eq.(2),  is  given  by 


(4) 


—  sin  03  -  sin  03 
cos  03  cos  03 


(5) 


The  Jacobian  has  a  1-diniensionaI  null  space  whose  basis  vector  can  be  conviniently  ob¬ 
tained  as  a  cross  product  of  the  row  vectors  of  The  velocity  constraint  due  to  the 
pseudoinverse  control  can  then  be  expressed  as 


sin  (03  -  03)  dOi  +  sin  (0i  —  03)  dO^  sin  (03  -  0i)  <103  =  0  (C) 

A  necessary  and  sufficient  condition  for  tlie  integrability  of  a  differential  expression  of 
the  form 


Vida -t- v-2  d/3  +  V'^d'y  =  0  (7) 

is  that  [5] 


Using  the  necessaiy  and  sufficient  condition  above,  it  is  quite  straightforward  to  show 
that  the  constraint  due  to  pseudoinverse  control,  given  by  Eci.(6),  is  not  integrable  or 
nonholonomic  in  the  general  case.  Therefore  the  three  link  manipulator  shown  in  Fig.l 
has  three  expressions  of  motion  under  pseudoinverse  control:  the  two  kinematic  relations 
given  by  Eq.(4),  and  one  nonintegrable  constraint  given  by  E<i.(6). 

In  the  general  case  of  a  redundant  manipulator  with  n  joints  in  an  m-dimensioiial 
workspace,  there  are  (n  -  tu)  nonholonomic  constraints  (the  number  of  nonhulonumic  con¬ 
straints  is  equal  to  the  degree  of  redundancy  in  the  system)  imposed  by  pseudoinverse 
control  and  m  kinematic  relations  for  a  total  of  n  expressions  of  motion.  Of  course,  the 
nonholonomic  nature  of  the  pseudoinverse  constraints  need  to  be  ascertained  from  the 
more  general  test  for  integrability  in  n  dimensions,  provided  in  Appendix- A. 

When  the  manipulator  has  as  many  degrees  of  freedom  as  the  dimension  of  the 
workspace,  ie.  m  =  n,  the  Jarxibian  is  scjuare  and  has  no  null  sparx:  assuming  of  coursii 
that  the  system  is  not  at  any  singular  configuration.  Then  the  pseudoinverse  control  dues 
not  impose  any  nonholonomic  constraints;  the  motion  of  the  system  is  entirely  governed 
by  the  n  direct  kinematic  relations  that  are  holonomic. 

2.2  Repeatability  using  the  Extended  Jacobian 

Consider  a  simple  nonholonomic  system  whose  constraint  eciuation  is  of  the  form 

dz  =  adx  +  bdy  (9) 
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where  x,  y,  and  z  are  the  system  variables,  and  a  and  b  are  functions  of  x  and  y.  'Die 
variables  x  and  y  can  be  considered  to  be  the  independent  variables  of  the  system  and  z 
may  be  considered  to  be  the  dependent  variable.  If  x  and  y  move  along  a  closed  path,  the 
change  in  the  dependent  variable  z  is  expressed  as 


(I  -  g) 


In  the  above  equation  the  line  integral  was  conviniently  expressed  as  a  surface  integral 
using  the  generalized  Stokes’  Theorem  (1]  on  the  2-dimensional  oriented  manifold  D.  dD 
is  the  path  of  line  integration  and  is  the  boundary  of  the  domain  D.  Since  the  (.-onstrainl 
in  Eq.(O)  is  a  nonholonoinic  constraint,  we  can  show 


dx  By 

by  using  the  test  for  integrability  in  Eqs.(7)  and  (8).  Then  it  simply  follows  that  the 
dependent  variable  z  does  not  move  along  a  closed  path  as  the  indepenrlent  variables  x 
and  y  move  along  closed  paths.  Clearly,  all  the  variables  of  the  nunholonomic  system 
in  Eci.(O)  do  not  move  along  closed  paths  simultaneously.  This  is  true  for  nunholonomic 
systems  in  general  including  redundant  manipulators  under  pseudoinverse  control.  The 
pseudoinverse  control  of  redundant  manipulators  result  in  nonrepeatable  motion  of  the 
joint  variables.  Conversely,  holonomic  systems  are  diaracterized  by  repeatability  in  the 
configuration  variables  that  can  be  proven  directly  from  the  test  for  integrability. 

The  problem  of  nonrepeatability  of  nonholonomically  constrained  redundant  manipu¬ 
lators  under  pseudoinverse  control  can  be  remedied  by  using  the  extended  Jacobian  method 
[2].  For  a  n  joint  redundant  manipulator  with  an  m-dimensional  workspace,  the  extended 
Jacobian  method  imposes  (n  -  m)  independent  holonomic  constraints  of  the  form 


g{0)  =  ii,  (10) 

These  holonomic  constraints  are  similar  to  the  direct  kinematic  relations  in  Eq.(l)  and 
can  be  used  to  augment  the  manipulator  Jacobian  in  Eci.(2)  for  constructing  the  extended 
Jacobian  as  follows 


The  above  equation  indicates  that  we  have  ai  tificially  increased  the  dimension  of  the 
workspace  from  m  to  n  and  in  effect  we  now  have  a  nonredundant  manipulator  with  a 
square  Jacobian.  Rom  our  discussion  in  section  2.1,  we  know  that  the  pseudoinverse 
control  of  such  a  manipulator  does  not  impose  any  nonholonomic  constraints.  The  mo¬ 
tion  of  the  system  is  then  governed  completely  by  the  m  direct  kinematic  relations  in 
Eci.(l)  and  the  («  -  m)  additional  constraints  of  Eq.(lO).  Holonomic  systems  are  char¬ 
acterized  by  repeatability  and  the  extended  Jacobian  technique  achieves  repeatability  by 
converting  the  “redundant-manipulator-pseudoinverse-control”  nonholonomic  system  into 
a  holonomic  system. 


5 


An  alternative  way  to  look  at  the  extended  Jacobian  technique  is  to  reconsider  tlie 
constraints  in  Eci.(ll).  If  we  group  the  joint  variables  0  e  It^  into  two  sets  consisting  of 


01  e  W”  and  02  e  we  can  write  from 

Eki.(ll) 

X  =  Jl  01  +  J2  02, 

(12) 

0  =  Jai  01  +  J(j2  02, 

7  ^  ( ^9  \  7 

(13) 

Since  the  (n-m)  constraints  in  EcpflO)  are  all  independent,  it  will  be  possible  txi  find  tlie 
set  02  €  if*-’"  such  that  the  matrix  J02  is  always  invertible.  Then  Eris.(13)  and  (12)  ciin 
be  written  as 


02  =  — t/ca  '  Jat  0i  (14) 

X  ^J0i,  j  =  (Ji  -  e  /r*’"  (15) 

The  above  equations  are  modified  differential  forms  of  Etjs.(J)  and  (10)  and  aie  therefore 
holonomic  in  nature.  Since  the  Jacobian  J  is  square,  the  system  in  Eri.(15)  virtually 
represents  a  nonredundant  manipulator  with  x  as  the  workspace  and  0i  as  the  joint  s])ace. 
Therefore  the  pseudoinverse  control  of  E(i.(15) 

di  =  j*x  (to) 

imposes  no  njnholonomic  constraints.  This  follows  from  our  discussion  in  section  2.1.  This 
along  with  the  fact  that  Ek{.(15)  is  a  holonomic  equation  implies  that  the  constrainis  of 
motion  of  the  system  in  Eci.(16)  are  holonomic.  Therefore  closed  paths  in  the  workspace 
X  will  result  in  closed  paths  in  the  joint  space  0i,  provided  the  mani])u]8lor  does  not  pass 
through  any  singular  configuration.  This  follows  from  our  discussion  earlier  in  this  section. 
Additionally,  siirce  Eci.(I4)  is  holononric,  closed  paths  iir  the  space  of  the  independent 
variables  0i  will  result  in  closed  paths  in  the  space  of  Oj  -  the  dependent  variable.  In  effect 
the  extended  Jacobian  method  will  lift  closed  paths  in  the  workspace  x  to  closed  paths  in 
the  joint  space  comprisiirg  of  both  0i  and  02- 

2.3  Redundancy  in  Space  Manipulator  Systems 

Space  robots  exhibit  nonholonomic  redundancy  [12]  -  a  special  type  of  redurrdancy 
that  exists  in  the  absence  of  ordinary  kinematic  redundancy.  Unlike  ordinary  kiireinatic 
redundancy,  nonholonomic  redundancy  manifests  itself  only  after  a  global  motion  and 
cannot  be  cliaracterized  by  self-motion  manifolds.  Inspite  of  fundamental  diiferences,  both 
redundancies  are  responsible  for  nonrepeatable  motion  of  the  configuration  variables  under 
pseudoinverse  control.  The  nonrepeatability  in  the  configuration  variables  are  a  direct 
manifestation  of  nonholonomic  constraints  of  motion.  In  the  case  of  ordinarily  redundant 
terrestrial  robots  the  nonholonomic  constraints  are  imposed  by  the  pseudoinverse  control 


itself,  whereas  in  the  case  of  space  robots  the  nonholonomic  constraints  are  naturally 
imposed  by  the  conservation  of  angular  momentum. 

Consider  a  space  manipulator  system  with  manipulator  joint  variables  0i  e  in  a 
workspace  x  e  A™.  The  manipulator  is  chosen  to  have  as  many  degrees  of  freedom  as  the 
dimension  of  the  workspace  to  exhibit  the  manifestation  of  nonholonomic  redundancy  in 
the  absence  of  ordinary  kinematic  redundancy.  The  orientation  of  the  space  vehicle  on 
which  the  space  manipulator  is  mounted  is  denoted  by  0o  €  A*.  Figure  2  depicts  a  planar 
space  manipulator  for  whicli  m  =  2  and  Jt  =  1.  It  can  be  shown  (11],  [12]  that  tire  direct 
kinematic  relation  of  the  space  manipulator  is  of  the  form 


which  has  the  structure 


x  =  f{0i,0^) 


(17) 


X  ~  Ji  0\  +  JoOo  (1^) 

in  differential  form.  The  nonholonomic  constraint  due  to  angular  momentum  conservation 
can  be  expressed  as  [11] 


eo  =  HiOi)di  (ly) 

A  complete  description  of  the  matrix  H  e.  can  be  found  in  (11).  Erjuation  (19)  can 
be  substituted  in  Eci.(18)  to  obtain 

X  =  Jdu  J  =  {J,  +  JoH)  (20) 

where  J  €  is  the  “generalized  Jacobian”  (19j. 

The  generalizetl  t;oordinates  of  the  system  include  0i  e  A"‘  and  0^  6  A*.  The  total 
number  of  generalized  coordinates  is  (*u  +  k)  and  the  dimension  of  the  workspace  is  m. 
The  redundancy  in  the  space  manipulator  system  is  due  to  the  higher  dimension  of  the 
generalized  coordinates  than  that  of  the  workspace.  The  difference  in  the  number  of 
generalized  coordinates  and  the  workspace  variables  is  etiual  to  the  degree  of  redundancy 
in  the  system.  This  is  similar  to  ordinary  kinematic  retlundancy  in  terrestrial  manipulators. 

A  fundamental  difference  in  the  redundancy  between  space  manipulators  and  terres¬ 
trial  manipulators  is  that  the  dimension  of  the  input  space  is  equal  to  that  of  the  gener¬ 
alized  coordinates  in  the  case  of  terrestrial  manipulators  whereas  for  space  manipulators, 
the  dimension  of  the  input  space  is  smaller  than  the  dimension  of  the  generalized  coor¬ 
dinates.  The  inputs  for  terrestrial  manipulators  are  the  derivatives  of  all  the  generalized 
coordinates,  for  space  manipulators  they  comprise  of  the  derivatives  of  the  independent 
generalized  coordinates  only,  the  orientation  variables  of  the  spac;e  vehicle  being  the  de¬ 
pendent  generalized  coordinates. 

A  closer  look  at  Etis.(19)  and  (20)  point  out  their  similarity  to  Etis.(14)  and  (15). 
Though  the  eciuations  look  similar,  they  are  fundamentally  tliflerent  because  E<is.(14)  and 
(15)  are  holonomic  while  E<is.(19)  and  (20)  are  nonholonomic  in  nature.  Due  to  this 
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difference,  the  extended  Jacobian  method  of  redundancy  control  results  in  repeatable  joint 
motion  in  ordinarily  redundant  terre£  trial  manipulators  whereas  the  pseudoinverse  control 
of  the  generalized  Jacobian  (19]  results  in  nonrepeatable  joint  motion  in  space  manipulators. 
A  more  complete  discussion  on  this  topic  is  presented  next. 

Consider  the  trajectory  control  in  the  three  different  cases  of:  (a)  a  nonholononhcally 
redundant  space  manipulator,  (b)  an  ordinarily  redundant  terrestrial  manipulator,  and  (c) 
an  ordinarily  redundant  terrestrial  manipulator  using  the  extended  Jacobian.  For  case  (a) 
the  forward  kinematics  is  expressed  by  Eqs.(17)  and  (19).  Since  Eq.(19)  is  nonholonornic, 
a  closed  path  in  6i  space  does  not  imply  a  closed  path  in  the  0o  space.  This  implies  from 
Eq.(17)  that  a  closed  path  in  the  joint  space  of  the  space  manipulator  does  not  result  in 
a  closed  path  in  the  workspace.  For  cases  (b)  and  (c)  the  forward  kinematics  is  sjm])ly 
expressed  by  Eq.(l)  -  a  position  constraint.  Therefore  a  closed  path  in  the  joint  space 
will  necessarily  result  in  closed  trajectories  of  the  end-effector  variables.  For  end-effc^Loi 
trajectory  control  in  case  (a),  we  use  the  pseudoinverse  control  law  from  E<i.(20) 

di  =  J*X  (21) 

to  plan  the  joint  trajectories.  Equation  (20)  is  a  nonholonornic  e.juation  because  it  was 
obtained  by  substituting  a  nonholonornic  equation,  namely  Eq.(19)  ir  to  a  holonomic  equa¬ 
tion,  namely  Eq.(18).  Therefore,  while  using  Efp(2l),  closed  trajectories  in  the  workspace 
will  generally  not  result  in  closed  trajectories  in  the  jrrint  space.  This  can  be  easily  proven 
by  contradiction.  Supjrose  that  closerl  trajectories  in  x  prtKhK:e  closed  trajectories  in  0i . 
We  know  from  the  nature  of  Eq.(19)  that  closed  trajectories  in  0i  do  not  usually  i)roduce 
closed  trajectories  in  Oo.  This  will  contradict  Eq.(17)  that  requires  the  trajectories  of  0o 
to  be  closed  for  closed  trajectories  of  x  and  0i.  For  case  (b)  closed  trajectories  in  the 
workspace  do  not  result  in  closed  trajectories  in  the  joint  space  whereas  for  case  (c)  they 
do.  This  follows  straight  from  our  discussion  in  section  2.2.  We  conclude  this  section  by 
summarizing  the  last  result  in  a  tabular  form. 

Closed  Path  in  Joint  Si)ace  Closed  Path  in  Workspace 
irnjjlies  implies 

Closed  Path  in  Workpspace  Closed  Path  in  Joint  Space 

Space  Manipulator  False  False 

Redundant  Manipulator  TVue  False 

(Pseudoinverse  Control) 

Redundant  Manipulator  'Hue  TVue 

(Extended  Jacobian) 

2.4  The  LBC  is  not  a  Sufficient  Condition  for  Repeatability 

Shamir  and  Yomdin  [16]  studied  the  repeatability  problem  in  redundant  manipulators 
and  derived  a  necessary  and  sufficient  condition,  the  Lie  Bracket  Condition  (LBC),  for 
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repeatability.  In  this  section  we  will  show  that  the  LBC  of  (16]  is  not  a  sufficient  coiuliiion 
for  repeatability  when  applied  to  aibitrary  extended  Jacobians  [2].  This  contradicts  some 
of  the  discussion  made  in  (9]. 

In  simple  words,  the  LBC  [16]  states  that  repeatability  in  manipulators  is  assured  if 
and  only  if  the  Lie  Bracket  of  any  two  column  vectors  ki  and  kj  of  the  matrix  K,  K  being 
the  pseudoinverse  of  the  manipulator  Jacobian,  is  a  linear  combination  of  the  columns  of 
K. 

For  a  manipulator  with  as  many  degrees  of  freedom  as  the  dimension  of  the  workspace, 
the  control  matrix  K  is  simply  the  inverse  of  the  manipulator  Jacobian,  assuming  of  course, 
that  the  manipulator  is  not  at  any  singular  configuration.  The  LBC  is  satisfied  for  the 
square  and  full  rank  matrix  K,  and  indeed,  we  have  repeatable  joint  motion  when  the 
end-effector  moves  along  closed  paths. 

Since  the  LBC  is  always  satisfied  for  square  matrices  with  full  rank,  Luo  and  Ahmad 
[0]  extrapolated  that  repeatability  can  be  achieved  by  simply  converting  the  rectangular 
Jacobian  of  a  redumlant  manipulator  into  a  srpiare  matrix  by  imposing  additional  inde¬ 
pendent  constraints.  I'hey  supporte<l  their  argument  with  the  example  of  the  extended 
Jacobian  [2].  This  method  achieves  repeatability  by  imposing  additional  independent  con¬ 
straints  that  are  holonomic.  The  assertion  of  Luo  ant’  Ahmad  [9]  is  not  correct  because 
the  rectangular  Jacobian  may  be  extended  into  a  squaie  matrix  of  full  rank  by  imposing 
nonholonomic  constraints  as  well,  and  nonholonomic  systems  do  not  exhibit  repeatability. 
To  understand  better,  we  look  back  at  the  expressions  of  motion  of  a  redundant  mani])- 
ulator  under  extended  Jacobian  control  |2]  iuid  a  s)>uce  manipulator,  in  sections  2.2  and 
2.3  respectively.  Specifically,  we  compare  Eqs.(12)  and  (14)  in  section  2.2  with  likis.(18) 
and  (19)  in  section  2.3.  We  have  seen  in  section  2.3  that  these  two  systems  have  struc¬ 
turally  identical  kinematical  equations  and  constraints  but  the  nature  of  their  constraints 
aie  different.  Since  the  space  manipulator  has  nonholonomic  constraints,  closed  paths  in 
the  workspace  do  not  result  in  closed  paths  in  the  joint  space.  This  tells  us  that  if  the  con¬ 
straint  in  Eq.(14)  were  nonholonomic,  the  pseudoinverse  control  of  the  extended  Jacobian 
of  tlie  redundant  manipulator  in  section  2.2  would  exhibit  nonrepeaiable  joint  motion  as 
well. 

To  illustrate  nonrepeatability  in  redundant  manipulators  with  an  extended  Jacobian, 
we  consider  the  manipulator  in  Fig.l.  We  assume  all  the  link  lengths  to  be  equal  to  0.5  units 
for  the  sake  of  simplicity.  For  this  manipulator  which  has  a  single  degree  of  redundancy, 
we  impose  one  nonholonomic  constraint 


O3  =  sin(0i  +  O3)  01  +  cos(02  -i-  O3)  0-1 


The  extended  Jacobian  relation  of  the  manipulator  takes  the  following  form 

(X\  I  /  -sinffi  -sin  03  -sinOaX  /0i\ 

K  1  =  -  (  cos  01  cos  02  cos  03  I  (  03  I  (22) 

0/  \sin(0i 03)  cos(02-|-03)  -1  /  V03/ 

Except  at  the  singular  points,  the  pseudoinverse  of  the  extended  Jacobian  in  Eq.(22) 
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will  be  equivalent  to  the  inverse,  for  which  the  LBC  will  always  be  satisfied.  However, 
closed  paths  in  the  workspace  x  will  not  always  result  in  closed  paths  in  the  joint  space  0, 
as  seen  from  Pig.3.  Therefore,  the  assertion  made  in  [9]  is  not  correct. 

We  wish  to  make  two  comments  in  regard  to  Fig.3.  The  abcissae  and  ordinate  in  Fig.3 
are  in  different  scales.  Therefore  the  circular  path  of  the  end-effector  looks  elliptical.  For 
the  same  reason,  the  link  lengths  seem  to  vary  in  different  configurations.  Also,  it  may  be 
noted  that  the  manipulator  exhibits  a  limit  cycle  behavior  •  the  drift  in  the  joint  angles 
of  the  manipulator  deaeases  as  the  end-effector  repeatedly  moves  along  the  closed  path. 
This  limit  cycle  behavior  of  redundant  manipulators  will  be  explained  later  in  section  5. 

3.  A  Necessary  Condition  for  Repeatability 

Shamir  and  Yomdin  [16]  studied  the  repeatability  problem  in  redundant  manipulators 
and  arrived  at  a  Lie  Bracket  Ck)ndition  (LBC)  as  a  necessary  and  sufficient  condition  for  re¬ 
peatability.  The  LBC  is  by  itself  a  necessary  and  sufficient  condition  for  the  integrability  ol 
the  distribution  associated  with  the  Jacobian  pseudoinverse.  This  comes  directly  from  the 
statement  of  hYobenius’s  Theorem  (17).  This  was  proven  separately  for  the  3-dimensional 
case  in  [9],  [14].  In  essence,  Shamir  and  Yomdin  [16]  asserted  that  repeatability  can  be 
achieved  if  and  only  if  the  solution  to  the  pseudoinverse  control  problem  is  integrable.  We 
do  not  quite  agree  with  this  condition  since  there  exists  a  weaker  necessary  condition  for 
repeatability. 

Terrestrial  redundant  manipulators  under  pseudoinverse  control  and  nonholonomiirally 
redundant  space  manipulators  are  both  constrained  systems,  and  the  repeatability  ]>roblem 
in  these  redundant  systems  is  a  searcli  for  closed  trajectories  of  their  configuration  variables. 
We  take  into  consideration  the  constraints  of  the  systems  by  searching  for  closed  trajectories 
of  the  independent  configuration  variables  that  result  in  closed  trajectories  of  the  dependent 
configuration  variables.  The  change  in  the  dependent  configuration  variables  is  expressed 
as  a  line  integral  along  the  closed  path  in  the  space  of  the  independent  configuration 
variables.  This  line  integral  may  be  conviniently  expressed  as  a  surface  integral  using  the 
generalized  Stokes’  Theorem  on  a  manifold.  If  D  is  an  oriented  manifold  of  dimension  k, 
and  if  b;  is  a  {k  -  l)-form  on  D,  then  from  Stokes’  Theorem  [1]  we  have 

/  f  du  (23) 

Jao  Jd 

where,  dD  is  the  path  of  the  line  integration  and  is  the  boundary  of  the  domain  D,  and 
dui  isa.  diflferential  ik-form  obtained  by  exterior  dilferentation  of  u>.  In  the  case  of  a  planar 
terrestrial  manipulator  with  three  links  and  a  single  degree  of  redundancy,  the  domain  D  is 
a  2-dimensional  manifold,  and  the  differential  l-form  on  D  has  the  functional  dependence 

where,  ^  Is  the  dependent  joint  variable,  and  and  are  the  independent  joint  vari¬ 
ables  of  the  manipulator.  If  Eq.(24)  were  to  depict  the  constraint  in  a  nonholonornically 
redimdant  planar  space  robot  with  two  links,  would  represent  the  orientation  of  the 
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space  vehicle  in  the  plane,  and  and  ^  would  represent  the  joint  variables  of  the  two 
link  manipulator. 

Using  Stokes’  theorem,  the  line  integration  of  along  a  path  dD  on  the  2-dimensiunal 
manifold  D  of  and  ^  is  expressed  as 


f  d^  =  /  d^i  A  d^a 

JoD  Jd-  {yvi  onj 

where  “a”  denotes  the  exterior  product,  and  a,  the  orientation  of  D  has  the  same  orien¬ 
tation  as  d^i  A  d4>2  when  the  direction  along  the  path  is  counterclockwise,  otherwise  a  lias 
the  same  orientation  as  d^  a  d^t- 

If  the  constraint  given  by  Eq.(24)  were  a  holonomic  constraint,  then  we  would  have 


(25) 


^03  _  dgi 
04^1  04*3 

Then  the  change  in  the  variable  would  be  zero  for  all  closed  paths  in  the  domain 
D  because  of  the  integrable  nature  of  the  constraints.  This  would  ensure  repeatability. 
Our  contention  is  that  integrabiiity  is  a  sufficient  condition  for  repeatability  but  is  not 
a  necessary  condition.  For  the  nonholonomically  redundant  space  manipulator  or  the 
terrestrial  redundant  manipulator  the  condition  given  by  B(|.(25)  does  not  hold  good,  yet 
repeatability  can  be  achieved  for  certain  closed  paths  in  the  domain  D.  We  define 


F(4>i,4)2) 

d4>t  84>3 


(26) 


The  change  in  the  dependent  joint  variable  4>o  of  the  redundant  manipulator  for  a  positive 
direction  of  travel  in  the  space  of  the  independent  joint  variables  is  equivalent  to 


f  d4>o=  f  F(<^\,4»3)  44>\d4>2 

JoD  Jo 

=  F{4>\.4>1)  f  d4>xd4^i  =  F{4>\,4^)A{D) 

Jd 

where,  the  above  e<iuation  was  obtained  by  the  application  of  the  mean  value  theorem 
of  integral  calculus.  The  function  F  is  assumed  to  be  continuous  in  the  entire  domain 
D  and  hence  the  mean  value  theorem  applies,  and  ^  denote  some  point  within  the 
domain  D,  and  A(D)  is  the  measure  of  the  domain  £>;  in  this  case  it  is  simply  etiual  to  the 
area  enclosed  within  the  closed  curve  OD.  F{4t\,4>^)  can  also  be  interpreted  as  the  mean 
value  of  the  function  F,  defined  in  Eq.(26),  taken  over  the  domain  D.  If  this  mean  value 
happens  to  be  zero,  then  we  would  have  a  zero  net  change  in  the  dependent  joint  variable 
of  the  redundant  manipulator.  This  would  ensure  repeatability  in  the  joint  motion  of  the 
terrestrial  manipulator.  For  the  space  manipulator  this  would  ensure  repeatability  in  the 
motion  of  the  end-effector  in  the  workspace.  We  are  now  ready  to  state  the  necessary 
condition  for  the  repeatable  motion  of  the  redundant  manipulator. 
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Proposition:  A  necessai'y  condition  for  the  repeatable  motion  of  the  redundant  rnaui]ni- 

lalor  is  that  the  closed  path  dD  whidi  is  the  boundary  of  the  domain  D  in  the  inde])endent 
configuration  space  should  enclose  at  least  one  point  where  the  function  F  defined  by 
Eq.(26)  is  equal  to  zero. 

The  proof  of  the  proposition  stated  above  is  quite  straightforward  and  is  left  to  the  reatlei . 

If  the  necessary  condition  for  repeatability  is  satisfied,  it  may  be  possible  to  find 
paths  in  the  space  of  the  independent  configuration  variables  such  that  the  net  change 
of  the  dependent  configuration  variables  is  zero  over  the  closed  path.  The  closed  path  in 
the  independent  configuration  space  will  then  be  like  a  “holonomic  loop”  over  which  the 
nonholonomic  system  will  exliibit  holonomic  behavior  globally.  Incidentally,  the  holonomic 
loops  will  not  belong  to  any  integral  surface  and  as  such  the  LBC  or  the  integrability 
condition,  defined  in  Appendix-A,  will  not  be  satisfied  at  all  points  along  the  loop. 

4.  Repeatability  in  Nonholonomically  Redundant  Space  Manipulators 

There  are  two  different  repeatability  problems  fur  a  space  manipulator  system:  (a)  the 
direct  problem  of  finding  a  closed  path  in  the  joint  space  of  the  manipulator  such  that 
the  end-effector  traces  a  closerl  path,  and  (b)  the  inverse  problem  of  finding  a  closed  path 
in  the  workspace  that  will  result  in  a  closed  path  in  the  joint  space  under  pseudoinverse 
control.  The  inverse  problem  can  be  solved  by  simply  solving  the  direct  problem  when 
the  number  of  manipulator  joints  is  equal  to  the  dimension  of  the  workspace,  as  in  our 
case.  This  is  true  because  in  such  situations  the  pseudoinverse  is  identical  to  the  inverse 
assuming  that  the  manipulator  is  not  at  any  singular-  configuration.  In  this  section  we 
consider  the  direct  repeatability  problem  of  a  planar  space  robot  with  two  links  mounted 
on  a  space  vehicle  as  shown  in  Fig.2.  Since  the  manipulator  has  two  links,  the  system  will 
exhibit  nonholonomic  redundancy  in  the  absence  of  ordinary  kinematic  redundancy. 

The  Cartesian  coordinates  of  the  end-effector  xn,  vb  of  the  manipulator  have  a  func¬ 
tional  dependence  of  the  form 


XB  =  VB  =  h(xo,yo,9o,9i,02)  (27) 

where  xo  and  yo  are  the  coordinates  of  the  center  of  mass  of  the  space  vehicle,  Oq  is  the 
orientation  of  the  vehicle,  and  Oi  and  0^  are  the  joint  variables.  The  motion  of  the  center  of 
mass  of  the  space  vehicle  is  governerl  by  a  holonomic  constraint  due  to  linear  momentum 
conservation.  For  zero  initial  linear  momentum,  this  can  be  reduced  to  the  form  |1 1] 

a:o  =  /3  {00, 01 . 02),  yo  =  /4  {00. 01 . 0i)  (28) 

Since  we  are  looking  into  the  repeatability  problem  of  a  planar-  space  robot,  we  consider 
closed  trajectories  of  the  joint  vai  iables.  If  the  orientation  of  the  space  vehicle  trace  a  closed 
curve  as  the  joints  move  along  a  closed  trajectory,  it  is  clear-  from  E<is.(27)  and  (28)  that  all 
the  configuration  variables  including  xq,  yo,  xb,  and  yB  will  move  along  closed  trajectories. 
This  is  not  true  in  the  general  case. 
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When  the  joints  move  along  closed  trajectories  and  the  system  maintains  zero  angular 
momentum,  the  cliange  in  the  orientation  of  the  space  vehicle  is  expressed  as  a  surface 
integral  using  the  generalized  Stokes'  Theorem  on  a  manifold,  as  given  by  Eq.(23).  The 
domain  D  will  be  the  2-dimensional  joint  space  of  the  manipulator  and  the  differential 
1-form  on  D  will  be  the  constraint  due  to  the  conservation  of  angular  momentum,  given  as 


u>  =  JBq  —  ^2)  ^3 

where  A,  B,  and  C  are  functions  of  and  6-i  and  are  defined  in  Appendix-B.  The  function 
F  defined  in  Eq.(26)  is  therefore  equal  to 

We  now  present  a  simple  method  to  plan  repeatable  paths  for  the  space  manipulator. 
All  paths  that  will  ensure  repeatability  will  have  to  satisy  the  necessary  condition  for 
repeatability,  developed  in  section  3.  Therefore,  we  first  take  a  look  at  all  points  in  the 
Oi-O-i  space  where  the  fimction  FiOuQ^)  in  Eq.(30)  is  identically  zero.  The  set  of  all  such 
points  constitute  a  smooth  curve,  as  seen  in  Fig.4. 

We  assume  our  closed  path  to  have  an  elliptical  sliape.  This  path,  as  seen  in  Fig.5, 
can  be  parameterized  as  follows: 


0i  =  010  +  acos^cos2Kt  —  bsin^sin2ift 
=  020  +  a  sin  4>  cos  2Kt  b  cos  <t>  sin  2T(t 


t  6  |0, 11 


(31) 


where,  a,  and  b  are  the  major  and  minor  axes  of  the  ellipse,  4>  is  the  angle  of  inclination 
of  the  ellipse  with  the  0i  axis,  and  0io  and  02o  are  the  coordinates  of  the  center  of  the 
ellipse.  The  velocities  of  the  joints  of  the  manipulator  can  be  easily  obtained  from  the 
above  equation  as  a  function  of  time.  Consecjuently,  the  rate  of  change  of  the  orientation 
of  the  space  vehicle  can  be  obtained  from  Eq.(29)  as  a  function  of  time. 

We  stai't  with  an  initial  elliptical  path  which  is  characterized  by  the  paiameters  0io, 
020,  a,  b,  and  The  initial  choices  of  these  parameters  are  quite  arbitrary.  We  only  make 
sure  that  the  elliptical  path  encompasses  at  least  one  point  where  the  function  F  defined 
by  Eq.(30)  is  etiual  to  zero.  'I'liis  condition  can  be  easily  satisfied  by  considering  Fig.4 
which  provides  the  set  of  ail  points  where  the  function  F  vanishes. 

Our  goal  is  now  to  change  the  five  parameters  of  the  ellipse  so  that  the  surface  integi  al 
of  the  function  F  in  Eki.(30)  over  the  elliptical  path  is  equal  to  zero.  Of  the  five  different 
parameters  a  and  6  are  not  allowed  to  diange  independent  of  one  another.  This  is  because 
we  want  to  eliminate  the  trivial  solution  where  the  surface  integral  is  zero  because  the  area 
of  the  closed  path  is  eciual  to  zero.  One  simple  way  to  avoid  this  situation  is  to  impose  the 
restriction  that  the  area  of  the  ellipse  is  a  constant.  This  is  etiuivalenl  to  the  coiislraiiii 


adb  +  bda  =  0 


(32) 
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We  define  a  function  V  as  follows 


V'  =  C^  JJ^nOue2)d0i<W2  (33) 

and  solve  the  unconstrained  minimization  problem  by  implicitly  assuming  that  u  and  t 
are  dependent.  In  Eq.(33)  C  is  equal  to  the  net  change  in  the  orientation  of  the  space 
vehicle  as  the  joint  variables  move  along  closed  paths.  While  there  are  many  methods  for 
unconstrained  minimization,  we  choose  the  simplest  method  of  steepest  descent  [20].  Other 
alternative  methods  that  can  be  used  are  the  conjugate  direction  method  by  Fletcher  and 
Reeves  [4],  and  the  variable  metric  method  [20]  that  offer  improvement  over  the  method 
of  steepest  descent.  In  our  case  the  method  of  steepest  descent  works  well  and  thereruie 
we  adopted  it  only  for  its  simplicity. 

The  correct  clioice  of  the  independent  parameters  tfio,  ^ao,  and  a  that  provied  us 
with  the  steepest  direction  of  descent  of  the  function  V  are  computed  as 


dOio  = 


<1020  — 


In  the  above  equation,  the  quantities  (dQ/dOio),  {OC/dOio),  and  (dC/da)  aie  com¬ 

puted  by  numerical  partial  differentiation.  While  computing  the  term  (dc/da)  it  has  to  be 
remembered  that  a  change  in  a  is  accompanied  by  a  diange  in  6  given  by  the  constraint  in 
Eki.(32). 

The  optimization  teclmique  discussed  above  provides  us  with  a  systematic  way  to 
reach  the  local  minimum  value  of  the  fimction  V.  If  this  minimum  value  is  zero,  then  we 
have  converged  upon  the  desired  path  around  which  the  space  robot  will  exhibit  pseudo- 
holonomic  behavior.  In  the  general  case,  the  method  of  steepest  descent  does  not  guarantee 
the  convergence  of  a  function  to  its  global  minimum  value.  However,  in  our  case  the  method 
always  converged  to  the  global  minimum  value  of  V  =  0,  because  of  the  par  ticular  nature 
of  the  function  F  in  Eki.(30). 


5.  Repeatable  Motion  under  Pseudoinverse  Control 

The  repeatability  problem  in  redundant  manipulators  under  pseudoinverse  control  is 
a  search  for  closed  trajectories  of  the  end-effector  that  result  in  closed  joint  trajectories. 
Since  the  pseudoinverse  control  is  actually  a  form  of  nonholonomically  constrained  motion, 
closed  joiirt  trajectories  can  be  obtained  only  if  the  dependent  joint  variables  move  along 
a  closed  path  as  the  independent  joint  variables  do.  Our  logical  first  step  is  tlierefoie 
to  search  for  closed  trajectories  of  the  independent  joint  variables  that  result  in  closed 
trajectories  of  the  dependent  joint  variables. 

To  further  our  discussion,  we  consider  the  planar  redundant  manipulator  in  Fig.l  with 
unity  link  lengths.  This  example  was  considered  in  [7],  [9],  and  [IGj.  The  kinematic 
relations  of  this  manipulator  are  given  in  E(i.(4)  and  its  Jacobian  is  given  by  E(i.(5).  The 
nonholonomic  constraint  of  the  mani))uiator  under  pseudoinverse  control  is  given  by  irx|.(G), 
which  is  not  of  the  form  given  by  Eq.(24).  To  reduce  it  to  this  form,  we  use  the  simple 
transformation 
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(34) 


The  transformed  constraint  equation 

(Bin(V^  +  V^)  -  sin  V»a  -  sin  d^i  -  sin  c/03  +  |sin(V*3  +  ^s)  -  sin  02I  c/02  =  0  (35) 

is  then  of  the  form  as  given  by  Bq.(24).  Under  the  assumption  that 

sin02 +sin03  —  sin(02  +  03)  ii^  0  (36) 

the  change  in  the  dependent  variable  0i,  as  the  independent  variables  02  and  0^  move 
along  a  closed  path,  can  be  sliown  to  be 

^^</0,  _  (sin02  +sin03  -sin(02  +  03)1 
using  Stokes*  Theorem  (1).  The  function  F  defined  by  Eq.(26)  is  given  as 

F(^h,ih)  (sin02 +  sin03 -sin(02  +  03)1 

and  is  not  equal  to  zero  anywhere  in  the  02-03  plane.  The  necessaiy  condition  for  repeata¬ 
bility  is  therefore  not  satisfied.  This  means  that  when  the  condition  in  Eq.(36)  holds  good, 
the  redundant  manipulator  cannot  exhibit  repeatability.  The  condition  in  Eti.(36)  does 
not  hold  good  when  we  have  any  one  of  the  three  cases 

(а)  02  =  0  <=>■  0i  =  0-2 

(б)  03  =  0  < — >  02  =  03 

(c)  02  +  03  =  0  •<=»  03  =  01 

Using  Eq.(35),  it  is  possible  to  show  that  the  three  cases  above  imply 

(tt)  02  =  0  >-*  c/02  =  0 

(6)  03  =  0  •-»  c/03  =  0 

(c)  02  +  03  =  0  c/(02  +  0j)  =  0 

Therefore,  each  of  the  three  cases  represent  an  integral  surface.  These  results  aie  identical 
to  that  obtained  by  Shamir  and  Yomdin  (161  tising  the  Lie  Bracket  Condition  (LBC).  We 
have  to  agree  that  for  the  paiticular  mcample  considered,  repeatability  can  be  acliieved 
only  if  the  LBC  holds  good,  i.e.  the  LBC  is  a  necessary  condition  for  repeatability. 

The  LBC  is  not  a  necessaiy  condition  for  repeatability  in  the  general  case.  To  illustrate 
this  concept  we  consider  the  same  manipulator  as  in  Pig.l,  but  we  redefine  the  configuration 
variables.  Once  again  we  assume  the  link  lengths  to  be  unity  for  the  sake  of  simplicity. 
If  the  new  configuration  variables  are  0i,  02,  and  03,  as  defined  by  Eq.(34),  then  the 
kinematic  relations  of  the  manipulator  are 
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X  =  COsV'l  +C08V'lJ  +COsV'123 
Y  =  sin  +  sin  V'la  +  sin  ^123 


and  the  manipulator  Jacobian  is  given  by 


(38) 


j  _  / -sinV'i -sinV'ia -sinV'123  -  sin  V'la  -  sin  ^123  -sin^'iaa')  ,^9) 

^  y  00SV*1  +006^*13 -f  cos  V't33  COSV'ia  +  COsV'iaa  cos  0123/  '  ' 

where  we  used  the  compact  notation  0i3  and  0123  to  denote  (0i  02)  and  (0i  +  02  + 

03)  respectively.  We  note  that  the  Jacobian  in  the  above  equation  is  quite  different 
from  the  Jacobian  in  Elq.(5).  Consequently,  the  pseudoinverse  control  for  would  be 
considerably  different  from  that  of  J$. 

The  nonholonomic  constraint  of  the  manipulator  under  pseudoinverse  control  of  is 
found  to  be 


sin  03  -  (sin  0$  +  sin(V^  +  03)|  ii02  +  (sin  02  +  sin(02  +  03))  d03  =  0  (40) 

Assuming  sin  03  ^  0,  the  change  in  the  dependent  variable  0i,  as  the  independent  var  iables 
02  and  03  move  along  closed  paths,  can  be  shown  to  be 


sin  03  cos 02  -f  sin  03 cos(V>2  +  03)  -  sin  02 
sin  03® 


d02c/03 


The  function  F  defined  in  E(i.(2G)  is  therefore  equal  to 


(41) 


f^(02.03)  = 


sin  03  cos  02  -j-  sin  03  cos(02  +  03 )  -  sin  02 
sin  03® 


(42) 


To  plan  repeatable  paths  for  the  redundant  manipulator  under  pseudoinverse  control, 
the  necessary  condition  for  repeatability  discussed  in  section  3  has  to  be  satisfied.  There¬ 
fore,  we  take  a  look  at  a  set  of  points  where  the  function  F(03,03)  vanishes.  A  set  of  these 
points  is  given  in  Fig.6.  We  assiune  the  closed  path  in  the  space  of  the  independent  joint 
variables,  02  and  03,  to  have  an  elliptical  shape,  as  shown  in  Fig.7.  The  path  in  02  and 
03  is  parameterized  in  a  way  similar  to  Eiq.(31).  We  start  with  an  initial  droice  of  the 
parameters  020,  03o,  a,  6,  and  0.  The  choice  is  quite  arbitrary  except  for  the  fact  that  the 
path  should  enclose  at  least  one  point  where  the  function  F  defined  by  E(i.(42)  is  criuul 
to  zero.  This  condition  can  be  satisfied  by  considering  Fig.6.  Our  goal  is  now  to  change 
the  five  parameters  of  the  elliptical  path  so  that  tlie  surface  integral  of  the  function  F  in 
Eq.(42)  over  the  path  is  equal  to  zero.  We  achieve  our  goal  by  adopting  the  optimization 
technique  outlined  in  section  4.  The  optimized  path  can  then  be  likened  to  a  “holonomic 
loop”  over  which  the  joint  angles  of  tire  redundant  manipulator  will  exhibit  holonomic 
behavior  globally. 

Let  us  define  the  oi)timized  closed  path  in  the  joint  space  to  be  Cj.  Using  forward 
kinematics,  as  given  by  Eq.(38),  we  can  obtain  a  closed  path  in  the  workspace  Cw  of  the 
redundant  manipulator  from  Cj.  Under  pseudoinverse  control,  Cw  will  map  back  to  Cj 
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in  the  joint  space.  Tliis  is  true  because  (a)  tlie  mapping  Cj  > — »  Cyv  satisfies  tlie  kine¬ 
matic  relations  of  the  manipulator,  and  (b)  the  closed  path  Cj  satisfies  the  nunhulonomic 
constraint  due  to  pseudoinverse  control. 

Before  we  conclude  this  section  we  wisli  to  make  two  comment: 

1.  It  can  be  shown  that  the  Lie  Bracket  Condition  (LBC)  in  [16]  is  not  satisfied  at  every 
point  on  Cj,  yet  the  net  change  in  the  dependent  joint  variable  V*!  along  Cj  is  zero. 
Therefore,  we  can  adiieve  repeatability  in  the  absence  of  an  integral  surface. 

2.  Our  second  comment  is  in  regards  to  the  limit  cycle  behavior  in  redundant  manipu¬ 
lators.  It  was  noted  in  [7]  that  under  pseudoinverse  control  some  manipulators  drift 
continuously  while  others  exhibit  limit  cycle  behavior.  Our  studies  lead  us  to  believe 
that  the  drift  in  a  redundant  manipulator  may  be  self-optimizing  in  the  sense  that 
the  drift  may  decrease  with  every  cycle  of  end-effector  motion.  When  such  a  situation 
arises,  the  drift  finally  goes  to  zero  and  the  manipulator  reaches  a  limit  cycle. 

6.  Simulations 

6.1  A  Nonholonomically  Redundant  Space  Manipulator 

We  carried  out  several  computer  simulations.  Here  we  present  results  of  one  particular 
case.  The  kinematic  and  dynamic  parameters  of  the  planar  space  robot  were  cliosen  to  be 

Kinematic  and  Dynamic  parameters 


Mass 

Inertia 

Length 

(kfi) 

(m) 

Vehicle 

27.440 

1.520 

r  =  0.20 

Link-1 

5.380 

0.115 

/,  =  0.50 

Link-2 

2.640 

0.028 

Ij  =  0.35 

The  initial  parameters  of  the  eliiptimi  path  were  arbitrarily  cljosen  as 

a  =  1.50000,  6=1.00000,  ^  =  0.75000,  tf,o  =  0.50000,  (>20  =  0.50000  (43) 

where  the  units  are  in  radians.  For  these  set  of  values,  the  numerical  value  of  the  surface 
integral  C  was  found  to  be  C  =  -0.162775.  The  convergence  criterion  was  set  at  | Cl  ^ 
1.0  X  lO”*.  The  values  of  the  path  parameters  after  convergence  were 

0=1.31117,  6=  1.14381,  ^  =  0.79302,  ®io  =  0.34094,  ^jo  = -0.07054  (44) 

The  two  elliptical  paths  aie  shown  in  Fig.8.  Ellipse  I  corresponds  to  the  initial  choice 
of  the  path  parameters  given  by  Eq.(43)  for  which  the  value  of  C  =  -0.162775.  Ellipse 
II  coiTeiq)ond8  to  the  optimized  values  of  the  path  parameters  given  by  Eq.(44)  and  the 
value  of  C  for  this  path  was  C  =  -9.9636  x  I0~°.  'I  he  sinusoidiU  curve  it)  Fig.4  is  inset  in 
Fig.8.  This  curve  passes  through  both  paths  /  and  II  and  therefore  these  paths  satisfy  the 
necessary  condition  discussed  in  section  3. 
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Figures  9  and  10  depict  the  motion  of  the  end-effector  of  the  space  robot  for  20  cycles 
for  the  elliptical  paths  I  and  II  respectively.  The  end-effector  configuration  is  seen  to  drift 
in  Pig.9  but  has  negligible  drift  for  the  closed  path  in  Pig.  10.  The  magnitude  of  the  drift 
was  computed  to  be  approximately  76.96  mm/cycle  in  the  case  of  path  I  whereas  it  was 
only  0.87  mm/cycle  for  path  77. 

6.2  An  Ordinarily  Redundant  Terrestrial  Manipulator 

We  considered  the  simple  case  of  a  planar  three  link  manipulator  with  one  degree 
of  redundancy,  as  shown  in  Pig.l.  'I'he  kinematic  relations  of  the  manipulator  and  its 
Jacobian  are  given  by  Eqs.(3S)  and  (39).  We  assumed  the  links  of  the  manipulator  to  have 
equal  lengths  of  0.5  metres. 

The  initial  parameters  of  the  elUptical  path  was  arbitrarily  chosen  as 

a  =  1.00000,  6=  1.00000,  ^  =  0.00000,  =  0  75000,  =  1  50000  (45) 

where  the  units  are  in  radians.  For  these  set  of  values,  the  numerical  value  of  the  surface 
integral  C  was  found  to  be  C  =  1.9838625.  'I'he  convergence  criterion  was  set  at  K  I  < 
1.0  X  10“*,  The  values  of  the  path  parameters  after  convergence  were 

a  =  1.03337,  6  =  0.96769,  ^  =  0.00232,  \6ao  =  0.51512,  =  1  42478  (46) 

The  two  elliptical  paths  are  shown  in  Pig.l  1.  Ellipse  7  corresponds  to  the  initial  choice 
of  the  path  parameters  given  by  l<ki.(45)  for  which  the  value  of  C  =  1.9838625.  Cllii>se  77 
corresponds  to  the  optimized  values  of  the  path  parameters  given  by  Eq.(46)  and  the  value 
of  C  for  this  path  was  C  =  9.0431  x  10“*.  The  sinusoidal  curve  in  Fig.6  is  inset  in  Pig.l  1.  This 
curve  passes  through  both  paths  7  and  77  and  therefore  these  paths  satisfy  the  necessary 
condition  discussed  in  section  3. 

Path  77  in  Pig.  11  is  the  optimized  path  in  the  plane  of  the  manipulator  that 
results  in  closed  loop  motion  of  the  dependent  joint  variable  V*!  ■  For  an  initial  value  of 
V>i  —  0.0,  the  closed  end-effector  trajectory  Cw  that  is  obtained  from  these  closed  joint 
trajectories  Cj  is  shown  in  Pig.  12.  Figure  12  also  shows  the  link  configuration  of  the 
manipulator  at  six  different  points  along  the  trajectory.  The  joint  trajectories  obtained 
through  pseudoinverse  control  of  the  closed  end-effector  trajectory  in  Pig.  12  are  shown  in 
Fig.  13.  The  joint  trajectories  in  Fig.  13  pertain  to  5  cycles  of  end-effector  motion.  The 
numerical  simulation  was  continued  for  more  than  100  cycles  and  the  joints  were  seen  to 
have  exceptional  repeatability.  This  conforms  to  our  discussion  in  section  5. 

We  wish  to  make  two  comments  at  this  juncture: 

1.  The  Lie  Bracket  Condition  (LBC)  in  (IG]  is  essentially  a  test  for  integrability  of  the 
distribution  spanned  by  the  cohunn  vectors  of  the  Jacobian  pseudoinverse.  Though 
the  LBC  can  be  verified  from  the  Jacobian  transpose  instead  of  the  pseudoinverse  [9], 
[14],  it  may  still  involve  a  significant  amount  of  symbolic  computation.  An  easier  way 
out  is  to  test  the  integrability  of  the  constraint  imposed  by  the  pseudoinverse  control. 
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We  can  use  Eqs.(7)  and  (8)  to  test  the  integrability  of  the  pseudoinveise  constraint 
In  Eq.(40).  For  the  joint  trajectories  in  Pig.  13  it  can  be  shown  that  the  condition  for 
integrability  is  not  satisfied  at  ail  points  along  the  path,  i.e.  in  E(|.(42)  is  not 

zero  at  all  points  along  the  path.  Therefore  repeatability  is  achieved  in  the  absence  of 
integrability.  This  refutes  the  LBC  in  [16]. 

2.  Since  the  end-effector  trajectory  is  generated  from  the  joint  trajectories  and  since 
the  initial  configuration  of  the  dependent  joint  variable,  Vi  in  our  case,  is  completely 
arbitrary,  any  rotation  of  the  end-effector  trajectory  in  Fig.  12  about  the  z-axis  will  also 
produce  repeatable  joint  motion.  Clearly,  there  are  infinite  end-effector  trajectories 
that  produce  repeatable  joint  motion. 

7.  Conclusion 

In  this  paper  we  promoted  the  concept  that  integrability  is  not  a  necessary  condition 
for  repeatability  in  nonhoionoinic  systems.  This  allows  \is  to  plan  repeatable  trajectories 
fur  free-flying  space  manipulators  with  zero  initial  momentum  whose  constraint  due  to  the 
conservation  of  angular  momentum  is  not  integrable.  This  is  important  because  it  allows 
a  space  manipulator  to  perform  repeated  tasks  in  space  without  any  drift  in  its  contig\ua- 
tion  variables.  Fbr  terrestrial  manipulators  under  pseudoinverse  control  the  nonhoionoinic 
constraint  is  imposed  by  the  control  law.  We  sliowed  that  under  pseudoinverse  control, 
repeatability  of  the  joint  variables  can  be  adiieved  in  the  absence  of  any  integral  surface 
and  by  virtue  of  the  presence  of  “holonomic  loops”.  These  loops,  when  they  exist,  allow 
a  nonholonomic  system  to  exhibit  repeatability  in  its  configuration  variables,  in  this  pa¬ 
per  we  presented  a  simple  optimization  technique  for  planning  repeatable  trajectories  for 
both  nonholonomically  redundant  space  manipulators  and  ordinarily  redundant  terrestrial 
manipulators. 
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APPENDIX-A 

The  necessary  and  sufficient  condition  that  the  differential  constraint  in  n  variables 


V|  dxi  +  Wj  dl2  +  V„  dXn  =  0 


is  integrable,  is  that  the  set  of  equations 


/  dv^  dvx  \  /  dv\  \  _  A 

Ux-A  flx,.  j  ^ 

(A,  /t,  1,2,-'',  ti) 

are  satisfied  simultaneously  for  all  different  combinations  of  A,  /i  and  u  [5]. 


APPENDIX-B 

The  terms  A,  B,  and  C  in  Eq.(29)  are  defined  as  follows 


A  =  /t  +  +  m3)  -h  -~(momi  mimj  +  4mom2)  +  -}^m3{mQ  +  mi) 

M  im  4A'i 

+ -Tj’rtofmi  I  2m2)»licostfi -I  — »i*2(mo  I- 0.5mi)l|l2«/iitf'2  \  j^vium3t  l3tos{0i  I  O3) 


A  f*  f*  2 

B  =  Ji+l3  +  +  »»0»»2)  -h  +  *”>)  +  ‘^»*2)riicos0, 

+  -^”*2(mo  0.bmi)lil3COs03  -h  ■^mom3rt2cos{0i  -t-  &3) 

M  £M 


tx  1  1 

C  =  l3  +  —mzimo  +  mi)  -h  ■^mom3l\l3coa03  +  }rrjmom3rl3cos(0i  +  63) 

4M  IM  ZM 

where,  mo,  mi,  and  m2  aie  the  masses  of  the  space  vehicle  and  the  two  links  of  the  ma¬ 
nipulator,  Jo,  /i,  and  I3  are  the  moment  of  inertias  of  the  space  vehicle  and  the  two  links 
about  their  center  of  masses,  r  is  the  distance  of  the  first  joint  from  the  center  of  mass  of 
the  vehicle,  h  and  I3  are  the  lengths  of  the  two  links,  M  =  mo -I- mi m2,  and  h  =  lo  +  h  +  h. 
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Figure  1.  A  planar  three  link  redundant  manipulator. 
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Figure  2.  A  two  link  planar  space  manipulator  mounted  on  a  space  vehicle. 
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rad) 


a  =  semi-major  axis  of  ellipse 
b  =  semi-minor  axis  of  ellipse 


P  -  (0io»®2(P> 


(T|j,T|2)  =  (acost,bsin  t) 


Figure  5.  Parametric  representation  of  the  elliptical  path  in  the  joint  space  of  the  sjiace 
robot.  P  is  the  center  of  the  ellipse,  and  <f>  is  the  angle  between  the  major  axis  of  the  ellipse 


f  2  (rad) 


(rad) 


-2  0 


0^  (rad) 


Figure  8.  Elliptical  paths  in  the  joint  space  of  the  planar-  sirace  robot.  Path  I  is  the  initially 
chosen  path  and  Path  11  is  the  optimized  path. 
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y  coordinate  of  end-effector  (m) 


Figure  11.  Elliptical  patlis  in  the  space  of  the  independent  joint  var  iables  of  the  three  link 
redundant  robot.  Path  I  is  the  initially  chosen  path  and  Path  II  is  the  optimized  path. 
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Figure  13.  The  repeatable  joint  trajectories  of  the  three  link  redundant  manipulator  gen¬ 
erated  through  pseudoinverse  control  of  the  end-effector  trajectory  in  Figure  12. 
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